#include"ros/ros.h"
#include"FusionCenter_KF.h"

int main(int argc,char **argv)
{
    ros::init(argc, argv, "test_sensor_KF");
    ros::NodeHandle n;
    FusionCenter_KF kf;
    ros::Subscriber sub = n.subscribe("sensor001",1000,&FusionCenter_KF::chatterCallback,&kf);
    ros::Rate loop_rate(10);
   while(ros::ok())
    {
         ros::spinOnce();
         kf.Print_z();
         loop_rate.sleep();
    }
    return 0;
}
